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Abstract 


Industrial robots are usually attached to a rigid base. Placing the robot on a 
compliant base introduces dynamic coupling between the two systems. The Vehicle 
Emulation System (VES) is a six degree-of-freedom hydraulically driven platform that is 
capable of modeling the interaction of the manipulator and the base. The VES employs a 
force-torque sensor as the interface between the dynamics of the robot and the admittance 
model of the base. 

A computer simulation of the VES is presented. Each of the hardware and 
software components are described, and it is shown how they are modeled in the 
simulation. The Simulink software package from the Mathworks is used as the 
programming environment. The performance of the simulation is compared with 
experimental hardware results to validate its accuracy. 

A second computer simulation is outlined. This simulation models the dynamic 
interaction of a robot and a flexible base, and can act as a comparison to the simulated 
motion of the VES. It may also simulate the disturbances that any general robot may 
impose on a compliant base. The simulation applies to any two dynamic systems if at least 
one is defined in mode space. 

Results are presented that compare the simulated VES motion with the motion of 
the VES hardware using the same admittance model. The two computer simulations are 
compared to determine how well the VES is expected to emulate the desired motion. 

Simulation results are given for robots mounted to the end effector of the Space 
Shuttle Remote Manipulator System (SRMS). It is shown that for fast motions of the two 
robots studied, the SRMS experiences disturbances on the order of centimeters. Larger 
disturbances are possible if different manipulators are used. 
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1. Introduction 


1.1 Background and Motivation 

Conventional robotic systems are designed to operate in industrial environments 
under the influence of gravity, mounted on rigid bases. However, as scientists continue to 
expand their research into the realm of outer space, the importance of space robotics is 
increasing. Human extra-vehicular activity is costly and involves potential danger to 
human life, so considerable research is being performed in the field of space robotics. 

The area of control algorithms for space robots is the subject of substantial 
investigation. Previous research includes the study of free-floating robots [1], trajectory 
planning through the use of kinematic redundancies of the manipulator [2], and the use of 
satellite attitude control torques to control satellite mounted robots [3], among others. 
Validation of robotic facilities and control algorithms is difficult in conventional 
laboratories, due to the influence of gravity. 

Researchers at the Massachusetts Institute of Technology (MIT), under a grant 
from NASA, have developed an Earth-based tool for the study of the dynamics of space 

robots [4], [5], [6], [7], They have designed and built the Vehicle Emulation System 
(VES) to study the effects of mounting a robot on a flexible base. The VES is shown in 
figure 1.1. The main hardware component of the VES is a six degree-of-freedom 
hydraulically driven Stewart platform. The VES employs a force-torque sensor as the 
interface between the robot and the control software. This sensor measures the static 
effects due to gravity, and the dynamic effects due to the motion of the robot. Baker [4] 
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Figure 1 . 1 Vehicle Emulation System with PUMA 560 Robot 
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offers a detailed description of the force-torque sensor, and an iterative algorithm for 
removing the effects of gravity, for space-based experiments. He also presents a real-time, 
on-line, approach to this problem, which is similar to the method outlined in [8]. Idris has 
evaluated the concept of controlling the VES using the VxWorks real-time operating 
system [5]. The kinematic design of the Stewart platform, including a discussion of the 
hydraulic components and all related hardware, is presented by Mueller [6]. Kuklinski 
furnishes an overview of the entire YES [7]. In addition, he presents a detailed 
description of the safety routines that are employed by the VES, and dynamic performance 
characteristics of the equipment. Williams has studied the kinematics of the Stewart 
platform [9]. He describes methods for computing the forward and inverse position and 
velocity kinematics of the platform, and gives examples to compare different methods of 
computation. 

In operation, the Stewart platform is commanded to emulate the motion of a 
compliant base, through software admittance control (refer to figure 1.2). Admittance 
control uses forces and moments (termed a wrench) as input variables to determine the 
current state of a dynamic system. The platform is moving under the robot as it emulates 
a compliant base. This motion generates a feedback wrench which is also measured by the 
sensor. The combined analog wrench is digitized and used as the forcing function to the 
admittance model defined in the control software. The effects of gravity are removed 
through gravity compensation. The equations of motion are integrated to provide the 
position and orientation (termed a pose) of the platform, and the VES inverse kinematics 
are solved to determine the actuator lengths that will move the platform to the new 
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Figure 1.2 YES Admittance Control 


location. The platform is controlled through position-derivative control. The MIT VES 
has been used to study decoupled mass-spring-damper systems [7], and robots mounted 
on massive mobile bases [10]. 

NASA Langley Research Center has a Vehicle Emulation System that was built at 
MIT. The primary purpose of the NASA VES is to study the dynamics of robots mounted 
on the Space Shuttle Remote Manipulator System (SRMS). The VES may be used to 
simulate other compliant bases, including satellite-mounted robots. The SRMS is a 
flexible arm that is expected to experience disturbances under the influence of an active 
robot mounted to the end effector. The process of controlling and minimizing these 
disturbances is called disturbance compensation. Papadopoulos has developed an 
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admittance model for the SRMS in four configurations [11], that will be used in 
conjunction with the VES to study methods of disturbance compensation. 

1.2 Overview of Document 

The research conducted is presented in the ensuing four chapters. 

Chapter 2 presents a computer simulation of the VES. The simulation is designed 
to study the effects of hardware and software changes before they are actually 
implemented. In addition, the simulation is utilized to analyze the predicted motion of the 
VES, and investigate whether component limits are expected to be exceeded. The 
operation of the Vehicle Emulation System is outlined in this chapter. Descriptions of the 
hardware and software components, and their interface, are presented. The software 
routines are outlined, and it is shown how they are combined to perform either admittance 
or trajectory control on the Stewart Platform. The forward position and velocity 
kinematics presented in [9] are expanded upon to derive the forward acceleration 
kinematics of the Stewart platform, for use in simulating the platform’s motion. 

This computer model is used to simulate the action of the VES as it emulates the 
motion of the SRMS-robot dynamic interaction. A separate computer simulation is 
developed in Chapter 3 that models the SRMS-robot dynamics. This tool is designed to 
validate the accuracy of the VES hardware, which is subject to numerous errors, including 
friction in the actuators, and a time delay between commanded motion and realization of 
this motion in the hardware. This second simulation is used to model the effects of 
mounting any general robot on the SRMS. This simulation can predict the motions of any 
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hypothetical robot on a flexible support structure, under the influence of a theoretical 
control strategy. 

The results of the research are included in Chapter 4. High and low frequency 
noise is shown to affect the force-torque sensor that provides the interface between the 
externally mounted robot and the VES. To verify the accuracy of the model, the 
simulated VES motion is compared with similar motions of the MIT VES. The simulation 
of the robot-SRMS dynamics is compared with the VES model, to determine how closely 
the VES will emulate the intended motion. 

Chapter 5 summarizes the research and presents some concluding remarks. 
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2. Computer Simulation of the Vehicle Emulation System 

This chapter presents a computer simulation of the Vehicle Emulation System. 
Descriptions of all major components are provided, and it is shown how they are modeled 
in software. 

The Vehicle Emulation System was designed and built by the Massachusetts 
Institute of Technology, under a contract from NASA. The hardware consists of a 
Stewart platform and a force-torque sensor. The platform, shown in figure 1. 1, is 
computer controlled. At each simulation time step, the software computes the desired 
position and orientation of the center of the platform top plate, solves the inverse 
kinematics to determine the appropriate leg lengths, checks the safety requirements, and 
communicates the reference leg lengths to the actuators. 

The Stewart platform is a hydraulically actuated platform. Each of the six 
prismatic legs is connected to the fixed base through two-DOF universal joints, and to the 
mobile top plate with three-DOF spherical joints. Equation 2.1 is the Kutzbach equation, 
which is used to determine the mobility, or number of degrees of freedom, of a 
manipulator [12]. 

M = 6(N - 1) - 5/i - 4/z - 3/3 - 2/4 - Js (2.1) 

In this equation, 7, is the number of joints with i-degrees of freedom, and N is the number 
of links, including the fixed base link. For the Stewart platform, there are fourteen links, 
two associated with each actuator, plus the top plate, and fixed link, so evaluation of 
equation (2.1) yields 

M = 6(14 - 1) - 5(6) - 4(6) - 3(6) = 6 . 
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Therefore, the platform has six degrees of freedom. 

Figure 2. 1 shows a side view of the VES, including the reference coordinate 
systems that are involved. The inertial system, {I), is fixed in space at the base of the 
platform, with its Z-axis up. The center of the platform top plate is where the platform 
frame, {P}, is located. These two frames are related through an X-Y-Z rotation about the 
fixed inertial axes, and a translation. In the figure, the platform is horizontal not rotated, 
so the {1} and {P} frames are aligned. The manufacturer provides the location of the 
force sensor’s coordinate system, {S}, which is fixed on the sensor. The sensor is rigidly 
attached to the platform. The VES will be operated with a robot (or robots) mounted on 


Robot 



Robot Adapter 
Plate 


Force-Torque 

Sensor 



x z 



Figure 2.1 Side View of Each Component of the VES, with Coordinate Frames 
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the force sensor, with an adapter plate mounting the robot to the sensor. The dimensions 
of the adapter plate are known, and the coordinate frame, {R}, is located at the geometric 
center of the plate (the plate is assumed to be of uniform mass distribution). In addition to 
these frames, the attached robot has frames associated with each link. 

There are a number of complications that may arise when utilizing a complex 
mechanical system such as the Vehicle Emulation System. These include the following: 

• The Vehicle Emulation System is composed of a variety of complex 
components. If hardware changes are to be made, the system would be out of 
service while these changes occur. The final effects of the modifications would 
not be known until they were completed, and the system was again operational. 

• The NASA VES is primarily intended to be used to observe the interaction of a 
robot with a mobile base. The task of mounting a different robot on the 
platform involves designing a hew adapter plate to make the connection 
between the robot and the force sensor, and then devising a method for lifting 
the robot onto the system. The PUMA adapter plate was relatively simple to 
design, but plates for the DOSS, and other robots, could be more complicated. 
In addition, it might be desired to place robots that are not readily available in 
the lab, or theoretically designed robots, on the VES. 

• All mechanical systems have physical limits associated with their operation. If 
it is possible to determine whether these limits will be exceeded before an 
experiment is performed, it could prevent damage to costly equipment. 
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These concepts were the motivation for developing a computer-based simulation 
of the VES. The Simulink software package, manufactured by The Math works as part of 
their MATLAB software, was chosen as the simulation environment [13]. Simulink is 
menu-driven, and includes a large variety of built-in functions, including filters, s- and z- 
domain functions, and non-linear capabilities. The user creates a schematic of the system, 
and can numerically integrate the equations of motion using Runge-Kutta, discrete state 
space methods, Adams-Gear, or other techniques. The results are available to be analyzed 
in the MATLAB environment. 

The major VES components that are modeled are the actuator dynamics and 
position control system, the software routines, the robot, and the force sensor. The 
Stewart platform forward kinematics are also solved, to provide the actual position and 
orientation, velocity, and acceleration of the platform in Cartesian space. This information 
is fed back to the robot model, to include the motion of the base in the calculations of the 
robot’s base wrench. This wrench serves as the input to the admittance model that the 
platform is emulating. Figure 2.2 shows the interaction between the functions. The 
software calculations, the position control loop, and the robot’s control system are 
performed at specific clock rates, which are controlled by the external clock. The clock 
increments time in intervals that are equal to the highest sampling rate associated with the 
system. The position control loop, operating at 2900 Hz, requires the fastest clock. The 
system time is propagated through each block. The following sections describe the 
Simulink blocks included in fig 2.2. 
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Figure 2.2 VES Computer Simulation: Main Flow Diagram 


2.1 Robot Model 

This section describes the Robot Control and Robot Statics and Dynamics blocks 
from fig 2.2, and defines the simulated robot. 

There are numerous methods for controlling manipulators, including resolved rate 
control, joint control, inverse position control, vision systems, and force control. The 
Robot Control block implements the desired type of control, specified by the user during 
the initialization routine. Currently, the code implements joint trajectory control. 
Additional control algorithms can be included, as long as the algorithm involves the 
calculation of each joint angle, rate, and acceleration for each simulation time step. If any 
parameter is not directly calculated, time integration or differentiation of the values that 
are calculated will result in a complete set of parameters. It is important that each of these 
elements are computed, because they are required by the Robot Statics and Dynamics 
code. 

The Robot Statics and Dynamics block computes the wrench exerted on the force 
sensor due to the motion of the robot and the mobile base, and the effects due to gravity. 
The computations are based on the Newton-Euler equations included in Appendix A. At 
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each simulation time step, the base motion is combined with the motions of the joints and 
propagated from the robot’s first link to the end link. The force and moment at the center 
of the link are also determined with the Newton-Euler equations. Then, the process is 
reversed, to calculate the wrench between links as they interact. These calculations are 
dependent on having an accurate model of the manipulator. 

Two robots that are available to be placed on the VES are the PUMA 560 and 
Dextrous Orbital Servicing System (DOSS). The PUMA 560 shown in fig 2.3 is a six 
degree-of-freedom serial robot produced by Unimation. The robot consists of a base link, 
a waist joint, a shoulder, an elbow, and a three-DOF wrist. The three wrist frames are 
located at the same point, and perform a roll-pitch-roll rotation. Table 2.1 contains the 
mass and inertia values, and the center of mass location for each link. 

The Dextrous Orbital Servicing System is a seven-DOF serial robot. Figure 2.4 
shows that the arm has shoulder and wrist roll, yaw, and pitch joints, along with an elbow 
pitch joint. The extra degree-of-freedom associated with the DOSS allows it to move in 
its workspace while optimizing some aspect of its motion. Table 2.2 contains the mass 
and inertia values, and the center of mass location for each link of the DOSS. 

During the initialization routine associated with the VES simulation, the user is 
presented with a menu of robots from which to choose. Additional manipulators are 
created by substituting the new mass parameters into the files. Hypothetical manipulators 
can also be simulated, as may robots with payloads that might be difficult to manage in a 
laboratory environment. 
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Link i 

Mass (kg) 

Center of Mass (meters) 
X Y Z 

Principle Moments of Inertia (kg-m 2 ) 

Ixx Iyy Izz 

H 

20.00 

0.000 

-0.015 

-0.380 

0.000 

0.000 

0.000 

U 

9.00 

0.000 

0.135 

-0.005 

0.000 

0.000 

0.350 

2 

17.40 

0.068 

0.006 

-0.016 

0.130 

0.524 

0.539 

3 

4.80 

0.000 

-0.070 

0.014 

0.066 

0.013 

0.086 

H 

0.82 

0.000 

0.000 

-0.019 

■ 

1.80e' 3 

wm 

5 

0.34 

0.000 

0.000 

0.000 




6 

0.09 

0.000 

0.000 

0.032 

wm 




* Note: These values are not included in [14]. They were estimated from the geometry of the PUMA 560. 


Table 2. 1 PUMA 560 Mass Parameters 14 
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Figure 2.4 Dextrous Orbital Servicing System 11 



Link i 

Mass (kg) 

Center of Mass (meters) 
X Y Z 

Principle Moments of Inertia (kg-m 2 ) 
Ixx Iyy Izz 

■ 

0.00 

0.000 

0.000 

0.000 

0.000 

0.000 

0.000 

1 

9.61 

0.000 

-0.117 

■ 

0.161 

0.089 

0.143 

2 

8.95 

0.131 

-8.89e' 3 

gnu 

0.097 

0.215 

0.201 

3 

20.98 

0.295 

m 


0.175 

0.023 

0.23 

■a 

16.52 

0.267 


0.000 

0.109 

0.436 

0.450 

5 

6.90 

||ig| 

HH 

m 

0.712 

0.082 

0.090 

6 

3.68 

0.000 

m 

nm 

0.046 

0.034 

0.046 

■ 

22.29 

0.000 

m 

um 

0.389 

0.315 

0.166 


* Note: These values are not included in [1 1]. They are the parameters for the mounting block, and were set to zero 
for simulation purposes. 


Table 2.2 DOSS Mass Parameters 11 
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2.2 Force-Torque Sensor 


The operation of the force-torque sensor is described in this section. Then it is 
shown how the sensor is modeled in the VES computer simulation. 

During admittance model simulations, the interface between the robot and the VES 
is the force-torque sensor. The active robot exerts forces and moments on the sensor, 
which processes the disturbance and sends a signal to the software. The control software 
directs the Stewart platform to move in accordance with the admittance model being 
emulated. 

The six channel force-torque sensor, model OR6-5- 1 Biomechanics Platform, 
produced by Advanced Mechanical Technology, Inc. (AMTI) is used by the VES. The 
design of the sensor is described in detail in refs. [4], and [15]. Figure 2.5 shows the 
structure of the force sensor with the appropriate axes. The sensor is comprised of rigid 
top and bottom plates, connected by load cells in the four comers. 

The sensor measures the applied forces and moments through the use of strain 
gages connected in Wheatstone bridge formations, as in figures 2.6 and 2.7. Figure 2.7 
displays the circumference of a single load cell, as if it had been peeled off and laid flat, 
exposing the fourteen gages. The asterisk is located at the bottom of the cell and faces the 
outside corner of the load cell, as indicated in fig 2.5. Figure 2.8 shows a side view of a 
single cell, with two sets of orthogonal axes. When a horizontal force, F x , is applied as 
shown, axis C s experiences a compression due to shear, while axis T s is in tension. Each 
cell contains a similar arrangement, with the outputs combined additively in the legs of 
Wheatstone bridges. A purely vertical force, F z , causes both Cs and T s to be in 

















Cs 
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Ts 


1 T 

C 

Figure 2.8 Side View of a Single Load Cell, with Orthogonal Sets of Axes 15 


compression, which, when configured in adjacent branches of the bridge, will tend to 
cancel each other, producing no net response. Referring to fig 2.7, it is observed that the 
gages are arranged symmetrically around the load cell. 

Under an applied wrench, Wheatstone bridge elements Ti and T 2 in fig 2.6 
experience tension, while Q and C 2 undergo compression of the same magnitude, AR . 

AR is a resistance which is proportional to the applied wrench component, W ; , according 
to AR = pWi, where (3 is a constant and W- t = F x , F y > F z , M x , M y , or M z . Assuming 

that the base resistance values in each branch of the bridge, R , are the same, mesh analysis 
produces 


V x -Vex- 2I X (R + AR) 
V 2 =Vex-2I 2 (R-AR) 


h 



Va 

4 R 


so that 


V.^Vi-Vx 


R R 


(2.3) 
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where V a is the output voltage from figure 2.6. 

The force sensor outputs six voltages that reproduce the applied wrench, 
according to equation (2.4), 

{VM = [S]{WM, (2.4) 

where {VTJ is the applied six-component wrench in the sensor coordinate system, {V s } is 
the corresponding output voltage vector, and [5] is the 6x6 sensitivity matrix. For an 
ideal sensor, [S] is a diagonal matrix with each element equal to the quantity (3//? , defined 
for the corresponding Wheatstone bridge. However, any such real device contains 
crosstalk between the channels, caused both by a bending of the sensor top plate and 
imperfect strain gages. As a result, the sensitivity matrix contains off-diagonal terms that 
represent crosstalk. 

The output voltages from the force sensor are typically in the millivolt range, and 
contain a noise component from the excitation voltage, Vex. The signals are passed 
through the Analog Devices wide bandwidth strain gage signal conditioners, model B31. 
The signal conditioners first amplify the voltages by an amount Aj, and then filter them 
through a two-pole low-pass Butterworth filter. The filter has a cut-off frequency of 20 
Hz, but this is adjustable with the addition of resistors and capacitors. The Analog I/O 
Board, #DT1401, from Data Translation, Inc., converts the analog signal to digital. The 
board has a gain of 305 mV/ADU (analog to digital unit). Therefore, the final wrench 
values that are communicated to the YES software are 


VRi- 


fiAiVex 

KadR 


Wi, 


(2.5) 


or 
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{V7?} = [S P ™c|{W0, 


( 2 . 6 ) 


where K ad is the gain of the A/D converter, and [S proc ] is the sensitivity matrix that now 
includes all terms for processing the signal. 

• Simulation Model of the Force-Torque Sensor 

Even though the force sensor employs Wheatstone bridges to determine the 
external wrench, equation (2.6) illustrates that the process reduces to a matrix operation. 
It is not possible to alter the force sensor internally to change the values in eq (2.3), so 
modeling the sensor at the resistor level serves no purpose. For this reason the sensor is 
modeled as a matrix, as indicated by the matrix multiplication block in fig 2.9. The other 
blocks in fig 2.9 are external to the sensor. 

Experimentation has shown that the excitation voltage, V ex , contains a high 
frequency noise component, along with a very low frequency drift component due to 
environmental factors (refer to section 4.1 for details). The low frequency drift occurs 
over periods of hours, which is much longer than any proposed simulation, so it is 
ignored. However, the presence of the low frequency drift implies that the force sensor 
will need to be re-calibrated periodically. The high frequency component is modeled (fig 
2.9) as Gaussian noise with a zero mean that is different for each channel. In addition, a 
bias is added to each wrench component, to simulate stray voltages that are present on 
each channel. This offset is taken into account during the calibration routine, as outlined 
in the next section. After amplification, the force sensor signal is filtered through 20 Hz 
two-pole Butterworth filters, to remove some of the noise. 
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Figure 2.9 YES Computer Simulation: Force-Torque Sensor Model 


2.3 Software 

This section describes the control software utilized by the VES, and explains how 
the code was modified for the VES simulation. 

The VES control software implements either admittance or trajectory control on 
the platform, and then the inverse kinematics are solved to determine the lengths of the six 
legs, which are commanded to the VES. Figure 2.10 shows the VES architecture, 
including the software/hardware interface. The control software is developed on a Sun 
Sparc Station using the C programming language, and loaded onto a Motorola 68030 
processor (Heurikon #HK68/V30XE), named the redSlave. The software is designed to 
run in real-time on the redSlave using the VxWorks operating system. A second 
processor, the blueSlave, based on the Motorola 68020 computer chip (Heurikon 
#HK68/V20), is also available. The blueSlave can be used to handle some of the control 
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Figure 2. 10 YES Architecture' 


















routines, or control the robotic manipulator. The two processors communicate using a 
VMEBus. 

The software tasks involve computing the desired trajectory, and communicating 
with the environment. The routines include: 

• Force Measurement: measuring the force applied to the force-torque sensor, 
which includes the motions of the robot, gravity effects, and the acceleration of 
the mobile base, 

• Gravity Compensation: computing the static wrench due to the robot and 
subtracting it from the measured wrench, resulting in the dynamic wrench, 

• Admittance Model: determining the next state for a simulated admittance 
model, 

• Trajectory Generation: determining the next state for trajectory control of the 
platform, 

• Inverse Kinematics: solving the inverse kinematics to determine the actuator 
lengths at the current simulation time step, 

• Safety Checks: checking the safety requirements to ascertain whether the 
platform is stable and under control, 

• Leg Communication: communicating the new leg lengths to the actuators. 
Appendix B contains a detailed description of the gravity compensation method. 

Appendix C describes the algorithm for each software routine. 

The main calling routine for the software control code is testPlatform.c. This 
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program is an interface that allows the user to select admittance control, trajectory 
control, the calibration routine, or the data collection routine. The calibration routine is 
used to compute the bias on the force sensor. Each of the six channels on the force sensor 
are sampled one hundred times and the average bias and standard deviation are computed. 
Each time the force measurement code is called, this average bias is subtracted from the 
measured input. The data collection routine permits the user to select system variables to 
be saved during execution so that they may be analyzed later. The admittance and 
trajectory control algorithms are described in the following paragraphs. 

Admittance control allows the VES to emulate the motion of a complex dynamic 
system, as it interacts with the environment. The NASA Langley VES will primarily 
investigate the interaction of one or more robotic manipulators and the Shuttle RMS in 
four configurations, using the admittance models developed by Papadopoulos [11]. These 
four configurations, shown in fig 2.11, are termed unberth, low hover, deploy, and 
capture, and are operational arm configurations for the SRMS. 

Six of the seven algorithms outlined above are required for admittance control; the 
program flow is shown in fig 2. 12. The sampling rate of the control software is limited by 
the execution time of the code, and is currently between 75 and 100 Hz. The clock 
interrupt routine handles the timing for the system, and if the control loop is completed 
before the next time step, it waits before closing the loop. TestPlatform.c invokes the 
safety checks routine, to ensure proper initialization of this subroutine. 

Trajectory control is used to command the platform to follow a pre-planned 
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(a) Unberth 


(b) Low Hover 



Figure 2. 11 Four Operational Configurations of the SRMS: (a) Unberth (b) Low 
Hover (c) Deploy (d) Capture 11 
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Figure 2.12 VES Software How for Admittance Control 
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motion. Currently, linear and sinusoidal motion is allowed. Figure 2.13 illustrates the 
flow between the four routines involved. Trajectory control is executed at 100 Hertz, and 
the clock interrupt routine controls the timing. 

• VES Control Software Simulation 

The VES Control Software block shown in fig 2.2 implements the software 
routines described in the previous section. The original C programming language 
subroutines are designed to run under the VxWorks real-time operating environment, and 
contain a considerable amount of VxWorks-specific commands. Some of the tasks 
performed by the VxWorks code involve multi-tasking, task-locking, and interfacing with 
the hardware. Most of the tasks involve coordinating the code to run in real-time, which 
does not occur using Simulink, so they were removed from the code. 

The Simulink Control Software accomplishes all of the calculations performed by 
the original code, with the timing requirements taken care of by the external clock 
described in section 2.1. Simulink outputs the following system parameters to the 
MATLAB workspace to be analyzed after the simulation: the total wrench applied to the 
force sensor; the static and dynamic wrench due to the robot; the position, velocity, and 
acceleration of the platform; and the leg lengths, velocities and accelerations. The leg 
velocity and acceleration calculations are not performed by the original code. They have 
been included so that they can be compared with the output of the position/derivative 
control loop, which is the actual state of each leg. 
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Temposonics Position 
Sensor 

Figure 2.14 Position/Derivative Control Loop 


2.4 Actuator Dynamics and Control 

The dynamics and control of the Stewart platform actuators are discussed. Then it 
is shown how they are modeled in the VES simulation. 

The six VES leg actuators are operated under closed-loop control, as illustrated in 
fig. 2. 14. The position/derivative (PD) control algorithm is implemented digitally, in 
assembly language, with user-specified gains K P and K D . The six controllers, or 
LegSlaves, are based on the 8-bit Intel 8031 microprocessor. The PD algorithm is of the 
form 

U(k) = K P E(k) - K d (X ( k ) -X(k- 4)) , 

where K P and K D are proportional and derivative gains, respectively. The Temposonics 
transducer operates at 2900 Hz, so that new feedback values are available every 341 (a,s. 
The PD algorithm averages two successive values from the Temposonics counter to get 
X ( k ), and ignores the third measurement. Thus, X (k) is available every 1023 (is. This 
number is subtracted from the reference leg command, resulting in the error, E(k ) . The 
PD code saves the previous four values of X (k), so that X(k-4) can be used in the 
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equation. This creates an averaging for the velocity signal, and prevents the subtraction of 
two nearly identical numbers when the platform is moving at a slow speed, resulting in the 
position feedback changing by about one bit per sample period. 

The 1 6 bit digital to analog (D/A) converter uses one bit for the sign, and fifteen 
bits for the binary number representation. The D/A converter has a gain of 

10 Volts , 

k oa = — 1S ~7~T~ - = 3.05x10^ Volts / digit , (2.7a) 

(256)(2 digits) 

where the factor of 256 scales the number from sixteen to fifteen bits, and there is a 
maximum output of ± 10 volts. The servo-amplifier has a gain of 4 mA/volt. 

Position feedback information is provided through the Temposonics position 
transducer. The operation of the transducer is based on the principle of transmitting an 
ultrasonic pulse through the center of the actuator. Each LegSlave board contains a 
fourteen bit, 40 MHz, counter to measure the transit time of the pulse. The inverse of the 
pulse speed is 9.09 |is/inch, resulting in a transducer gain of 

K t = (40M//z)(9.09|Xs / inch ) = 363.6 counts / inch . (2.7b) 

Mueller provides a derivation of the actuator dynamics [6]. The method is briefly 
described here. Equation (2.8) is the flow through an aperture 

Q = C d A j~AP> ( 2 - 8 ) 

where c d is the discharge coefficient, A is the area, p is the fluid density, and the 
differential pressure is given by 

Ap = Ps ~ Pl- (2.9) 
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In equation (2.9), p s and p L are the supply and load pressures, respectively. The area of 
the aperture is the product of the circumference of the spool, w, and displacement of the 
spool, x. If the input current, i, is proportional to the displacement through a 
proportionality constant, kj, the area becomes 


A - wx- wk : i. 


( 2 . 10 ) 


Combining the above three equations results in a non-linear expression for the flow: 


Q = c d wk/^— (p s - p L) , 


( 2 . 11 ) 


This expression is linearized in a Taylor series expansion about the valve displacement and 
load pressure, assuming a constant supply pressure, as shown in equation (2.12). 


8 Q 8 Q 

dQ = ~^di +~~dp L 

h 8 p L yL 


( 2 . 12 ) 


Taking partial derivatives of equation (2.1 1), and evaluating them at the operating point of 
the actuator, yields the linearized flow and pressure coefficients 


5 Q 

8i 


= w/-(p, - p L ) = C x 
Op V r 


(2.13a) 


and 


S Q 


8p L 


'op 


-c.wki 

a J /~i 

E C > ■ 

f-(Ps-Pt) 


(2.13b) 


Integration of equation (2.12) about the operation point produces the flow equation 


d^=dQ op =f 


8 Q 


op 


V + 8 p L 


P L op Aop ^ 'pPL 0 p' 


(2.14) 


op 


If the fluid is assumed to be incompressible, the actuator’s continuity equation is 
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dQ op = \y, (2.15) 

where y is the velocity of the piston, and the effective area is related to applied pressure 


through equation (2.16). 



(2.16) 


In this equation, m is the mass of the piston and actuator rod. Combining equations 
(2.14)-(2.16), and taking the Laplace transform results in the linearized open-loop transfer 
function for the actuator, 

y(s) C x K 

211 -L £ = (2 171 

i(s) C m 2 j(tj+1)' 

-—5 +A e s 


• Simulation Model of the Actuator Dynamics and Control 

The VES control software concludes by communicating the new leg lengths to the 
actuators, and reading back the actual actuator lengths. The Simulink model performs 
these operations, along with converting the leg velocities and accelerations to SI units. 
These values are processed by the forward kinematics, along with the leg lengths, to 
determine the actual state of the platform, in Cartesian coordinates. 

Figure 2. 15 shows the position/derivative control block for one of the leg 
actuators. Each of the six PD control blocks are identical in structure, with differing 
parameters in the Servovalve and Actuator transfer function, depending on whether an 
individual leg is retracting or extending. Equation (2. 17) presents the servo-valve and 
actuator transfer function. The value for K is 1.18 inches/sec/mA for actuator extension. 
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Figure 2.15 YES Computer Simulation: Position/Derivative Control Loop 


and 0.77 inches/sec/mA for retraction, and T =0.0064 seconds. The gains for the digital to 
analog converter, servo-amplifier, and Temposonics feedback transducer are given in 
section 2.5.1. K T is the transducer gain defined in eq 2.7b. It has been determined that 
the bandwidth of the VES actuators is approximately 6-8 Hz [7]. If higher frequencies are 
generated by the admittance model, they will not be reproduced during simulation. 

Appendix E contains a derivation that shows that there are possible stability 
problems with the admittance control concept as it is employed by the VES. The proof is 
for a hypothetical system, so the stability problems in the actual hardware might not be as 
pronounced at the proof indicates. Referring to fig 2.15, Filters 1 through 3 were added 
to the simulation to reduce the stability problems. Filter 1 is a second order Butterworth 
filter with a cut-off frequency of 30 rad/sec (4.8 Hz), and Filters 2 and 3 are third order 
Butterworth filters with cut-off frequencies of 30 rad/sec. These filters create the 
bandwidth (6-8 Hz) associated with the hardware. Filters with different cut-off 
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frequencies (40 and 50 rad/sec) were experimented with in the software to cover the range 
of 6-8 Hz, but could not adequately reduce the stability problems described in Appendix 
E. This could be due to linear filters approximating the non-linear dynamics of the 
actuators. 

2.5 Forward Kinematics 

The inverse position kinematics solution provides the joint angles or actuator 
lengths required to reach a specified end-effector pose within the workspace of a robot. 
The forward kinematics solution performs the opposite function, i.e., given the actuator 
values or joint angles, compute the Cartesian pose. Forward kinematics can be used in 
simulations, such as the one presented here. For the Simulink model, the actuator 
lengths, velocities, and accelerations produced by the PD control loop are processed by 
the forward kinematics solution to determine the actual motion of the platform. This 
information serves two purposes. First, it is fed back to the model of the robot to include 
the base motion in the calculation of the wrench due to the robot. Second, it is compared 
to the commanded motion from the admittance model defined in the software, to estimate 
the accuracy with which the simulated VES hardware models the desired motion. 

Williams derives the forward position and velocity kinematics for the NASA 
Stewart platform [9]. The next part of this section follows the development of his 
equations. The equations are then expanded upon to derive the forward acceleration 
kinematics. 
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Figure 2.16 Vector Description of a Single Actuator 9 


The vector description of the i* actuator leg is shown in fig 2.16, where {P} and 


{B } are the platform and base frames, respectively, and Bj and Pj represent the locations 
of the i* base and platform ball joints. The super and subscript notation on the position 
vectors is as follows: V/*) is the vector from point j to point k , expressed in the / 
coordinate system. If frame {B;} is aligned with frame {B}, then the following vector 
loop closure equation is valid 

B ( Bi P Pi )= B ( B P P )- B ( B P Bi ) + B pR p { p P Pi ), (2.18) 

n 

where P R is the following X-Y-Z fixed-axis rotation matrix [16] : 



cosy cos P 
sin y cos P 
. - sin P 


cosy sin P sin a - siny cos a cosy sin Pcosa + siny sin a 
siny sin P sin a - cosy cos a siny sin p cosa - cosy sin a 
cos P sin a cos pcosa 


(2.19) 
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The vectors describing the ball joint locations are p ( p P Pi ) = {P^, P iy , 0} r and 

*(%) = {B a ,B iy ,0} r , and are known from geometry. The location of the platform with 

respect to the base is B ( B P P ) = {x,y,z} T . Substituting these parameters into eq (2.18), 
and simplifying yields 

{x+R(ll)P ix + R(l,2)Pi y -B ix 

B { Bi P Pi ) = \y + R(2,l)P ix + R(2,2)Pi y ~ B iy , (2.20) 

z + R{3,l)P k + R(3,2)P iy 

where the super- and sub-scripts have been omitted from the rotation matrix. In eq (2.20), 
the unknowns are the platform position, {x, y, z} T , and orientation {0 X , 0 y , 0 Z } T , contained 
in the rotation matrix. Using the Euclidean norm to describe the i th leg, 

ll = \\ B ( Bi P Pi )\\ 2 , (2.21) 

the i* constraint equation is 

MX) = x 2 + y 2 + z 2 + 2(P ix R(l,l) + P iy R(l,2))(x- B^) + 2{P ix R{2,\) + ^/?(2,2))(y - B iy ) + 
2{P ix R{3,\) + P iy R{3,2))z - 2(xB ix + yB iy ) + (fi? +Bf y ) 2 + (P? + tf) 2 - 1 2 = 0 

( 2 . 22 ) 

for i=l,2,...,6, and X = {x,y,z,Q x ,Q y ,Q z ) T . Eqs (2.22) represent six coupled, non-linear 
equations, with six unknowns. 

Williams presents a method for determining the pose of the platform using the 
Newton-Raphson iterative technique to solve eqs (2.22). Starting with an initial guess for 
the unknowns, solve 

= (2.23) 
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where J NR is the Newton-Raphson Jacobian matrix. Then, using the new value as an 
initial guess, iterate on eq (2.23) until convergence to the desired degree of accuracy, thus 
solving the forward position kinematics. 

The Jacobian is a multidimensional form of the derivative that maps velocities from 
one space into another. For the VES, the Jacobian maps actuator velocities into Cartesian 
velocities according to eq (2.24). 

{X } = [/]{/<} (2.24) 

Taking the time derivative of eq (2.22) and simplifying yields 

( 2 . 25 ) 

where J M is the modified Jacobian matrix. This equation is similar to an inverted form of 
eq (2.24). However, the Cartesian rotational velocities in eq (2.24) are different than the 
Euler rotational velocities in eq (2.25): 


{X} = {x,y,z,(o x , 0 ) y ,co z } r * {X} = {x,y,z,0 x ,0 v ,0 z } 7 


(2.26) 


The relationship between the velocities is given by the 3-2-1 Euler rotation 

{0}=[A]{o)}, (2.27a) 
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The relation between the Newton-Raphson Jacobian given in eq (2.23) and the inverted 


modified Jacobian in eq (2.25) is 
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[J M ] - 2L i ^ NR ’ 


Finally, the Jacobian in eq (2.24) is related to the Newton-Raphson Jacobian through eq 


(2.29). 


rH-lJWil [ J m}uR [A] 


Equations (2.28), (2.29), and (2.24) present an algorithm for computing the forward 
velocity kinematics. First, calculate the Newton-Raphson Jacobian, and divide the i* row 
by the i* leg length, to obtain the inverted modified Jacobian. Then, create the [A] matrix 
and solve eq (2.29) for the inverted Jacobian. Finally, invert this matrix and evaluate eq 
(2.24). This illustrates that J NR can be used for both the position and velocity kinematics, 
instead of determining both J NR (for position) and J (for velocity) at each simulation time 


The next part of the derivation involves the forward acceleration kinematics. This 
is an extension of the velocity kinematics, and begins with the second time derivative of eq 
( 2 . 22 ): 


.. .. ^ a dF t dx 

2Z, +2Z,L,.-£^L ^ 


= flf L dX l dX + fdP L l- 

%dx) dt dt itdXjdt 

Tldxf %dXj X 
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d 2 F 

where the X terms are Euler coordinates, and — f is the derivative of the Newton- 

dXj 

Raphson Jacobian. Equation (2.30) is solved for L : to acquire the inverse kinematics, as 
in eq (2.31), or for X to acquire the forward kinematics solution, as in eq (2.32). 


1 


yj=lOXj j=lOXj j 


(2.31) 


X = 


' dF: Yf- ^ d 2 F : 


£ or j .. o r ■ a 

v =, dXj J ^ 




(2.32) 


In each of these equations, eq (2.27) relates the Cartesian and Euler velocities. Equation 
(2.33) is the time derivative of this equation, and shows the relation between the Cartesian 
and Euler accelerations. 
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Therefore, the forward kinematics solution for the Cartesian accelerations is 


m = {j i,y,z,eJ y ,Q z ) T , 


(2.34) 


where x, y, and z are computed from eq (2.32). 

Equations (2.23), (2.24), and (2.32) present the forward kinematics equations that 
are utilized by the Simulink software. The position is obtained iteratively, while the 
velocity and acceleration are obtained in one step. 
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3. Computer Simulation of SRMS-Manipulator Interaction 

This chapter presents an independent but approximate computer simulation of the 
SRMS-manipulator dynamic interaction that will act as a comparison to the simulated 
motion of the VES. The model also serves to simulate the disturbances that any general 
robot may impose on a flexible base. The model assumes small angle motion of the base, 
and applies to any two dynamic systems if at least one is defined in mode space. 

An SRMS admittance model has been developed from a NASTRAN model that 
includes 132 degrees-of-freedom [11]. Numerically integrating 132 coupled differential 
equations is computationally expensive. Transforming to mode space and truncating the 
mode shapes matrix reduces the number of degrees of freedom to be integrated, thus 
reducing the number of computations. 

The following paragraphs describe the SRMS-manipulator computer simulation. 
Figure 3. 1 shows the elements that comprise the simulation. 



Stationary 

Base 


Figure 3.1 Control Loop for a Model of the Interaction of a 
Mobile Base and an Active Robot 
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During the simulation, the robot is commanded to move in space. This is 
accomplished through trajectory generation, resolved-rate control, a vision system, force 
control, or another scheme. Currently, each joint of the robot is commanded to follow the 
path of a fifth-order polynomial, from an initial to a final angle, with zero initial and final 
velocity, and zero initial and final acceleration. At the new simulation time step, each joint 
has associated with it an angle, an angular rate, and an angular acceleration. 

Craig [16] and Luh, et al [17] present an algorithm for computing the wrench at 
the base of the robot, due to its motion, based on the Newton-Euler equations. Beginning 
with link 1 and propagating to link n, the link velocities and accelerations are computed. 
The Newton-Euler equations are also evaluated for each link. Then, the process is 
reversed from link n to link 1, this time calculating the forces and moments of interaction 
between successive links. The final reaction wrench at link 1 is transformed to the base of 
the robot. These calculations are performed assuming the robot is attached to a fixed 
base. The Newton-Euler iterative equations are included in Appendix A. 

The wrench that is generated is due to the motion of the robot alone, and is input 
to an admittance model. The admittance model is discussed in the following paragraphs. 
This simulation is an approximation to the motion, since it assumes that the motion due to 
a moving robot on a moving base is equal to the sum of the motion of the base acting on a 
stationary robot, and the motion of the robot acting on a stationary base. The equations 
involved are non-linear, so splitting the wrench in this manner is not exact. 



• Augmenting the Modal Mass Matrix 

The following derivation assumes small angle motion of the flexible base, and that 
the base mass, spring, and damping matrices do not change during the motion. The results 
are valid for any flexible base that is defined in mode space. 

In general, the robot’s motion causes the flexible base to vibrate and move. These 
combined motions create a wrench at the base of the manipulator. The wrench 
components can be split into a part due to the base motion acting on a stationary robot, 

[ M { \{x), and a part due to the robot’s motion acting on a stationary base, {W exl } , so that 

the admittance model has the form 

[ M] m + [C] { j } + [K] { x] = -[ M x ] {x} + Wat ) , (3.1) 


where 


{jc} = {X,0} r is the state of the n-DOF mobile base, comprised of a position 
vector, and angular rotations, 

{j£} is the acceleration vector for the robot, at its center of mass, and includes the 
centripetal acceleration, co x (co x r) , and the tangential acceleration, to x r , 
{W ext 1 = [Fgx^N^t) 7 is the external wrench due to the motion of the robot, 
comprised of the force and moment vectors. 


[M] = 


"•base 

0 



is the nxn mass matrix of the mobile base, made up of the mass 


and inertia sub-matrices, 


[C] = 


C l C 2 


_c 3 c 4J 


is the nxn damping matrix, comprised of four submatrices. 
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k { k 2 

[A'] = , , is the nxn stiffness matrix, comprised of four sub-matrices, 

-* 3 k 4 j 


and 

n\ 0 

[M,]= is the mass matrix of the robot, made up of the mass and inertia 

L 0 /J 

sub-matrices, defined at its center of mass. 

Equation (3.1) is an nxl vector equation describing the motion of the robot-base 
interaction. The equation is split into the following two (n/2)xl position and orientation 
vectors 

Mbase* +C X X +C 2 0+ k x X + k 2 0 

= -m l {X+© c xP c + © c x(© c xP c )} + F ext (3.2) 

= ~ F c + F ex, 

and 

hasc® + C 3% + C 4© + ^X + k 4 © 

=-%© c -P c x{m l {X+© c xP c + © c x(© c xP c ))) + N exn (3.3) 

=-%© c -P c xF c + N ext 

where {x} has been expanded to show the acceleration terms. In these two equations 0 C 
and 0 C are the angular velocities and accelerations of the center of mass of the 
manipulator. If the robot is assumed to be rigid, and its center of mass frame is aligned 
with the frame of the mobile base, then 0 C = 0 and 0 C = 0. P c is the vector location of 
the center of mass of the robot, defined in the robot’s base coordinate frame. 

The conversion from physical to mode space is x — <I>T| , where <t> is the nxn 
modeshape matrix. The matrix is composed of two (n/2)xn upper and lower matrices such 
that 
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0 = 0,T] 


(3.4) 


Mapping the motion into mode space, equations (3.2) and (3.3) become 


rrhaM + + c 2 0,f| + ^Oji + * 2 0 ,ti = 

+ {0,fj} xP c + {<D,f|} x ({0,f|} x P c )} + F ext 

and 

hase^n + c 3 0„f| + c 4 0, r\ + £ 3 Oji + * 4 0,r| = 

-7,0,11 ~P r x{m,{ {O u f} } + {0,f| )xP c + 
m}x({0,T\}xP c )}} + /V exl 

Equations (3.5) and (3.6) are now re-combined into the following nxl equation 
representing the motion of the combined system 


™ba 


0 


o h ase JLo, 


o.. 


h+ 


c, c 2 


O 

u 

o, 


L^3 


n+ 


k x k 2 
Jc , k A 




n = 


\N. 


o. 






w, o 

.0 7,. 

-{ {0,Ti} x P c + {0,11} x ({0,1)1 x P c )} ] 

A-P c x {^{{0„fi} + {0,11} xP c + {0,11} X ({<t>,ii} X P c )} } }J 


(3.5) 


(3.6) 


(3.7) 


or 


MOfj + COl) + AOr| = -M,Oii - j^l + j^“' | 

This is the mode space version of eq (3.1). Pre-multiplying by O^ and using mass- 
normalized mode shapes yields 


(3.8) 


7fj + 




* , 

2?<0, 

n+ 

to, 2 


n = M,Ori - o Jw u - o, r v^ + & w exl , 


(3.9) 
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for i=l,2,.„,n and 


&M<S> = I, 

O r Cd> = diag[2C,0)] , is the diagonal matrix of damping values, and 
= diag[c o 2 ] , is the diagonal matrix of natural frequencies. 

Equation (3.9) has cross product terms embedded within it. Some of these are altered 
using the skew-symmetric position-cross matrix: 



(3.10) 


Simplifying eq (3.9) and bringing the fj terms to the left-hand side of the equation 
produces 

Afj = 42C©]n - [co 2 Jn + [d>/ + d^J/n, { { 0 >,ii } x m,r\ }} + &W^ (3.11) 

where 

A = I +& Mj<t> - d> Jmft®, + 

Pre-multiplying by A -1 decouples the fj terms, facilitating the conversion to state space. 

fj = [ A]" 1 {42CcoJn - [to 2 ]r| + [<D/ + 0/91M { {d>,ti} x m,r\) )+&WJ. (3.12) 

Equation (3.12) represents the n coupled, non-linear, mode space equations of motion for 
the mobile base-robot interaction. This is the modal representation of the admittance 
model shown in eq (3.1). In general, there is no closed-form solution to these equations. 
Numerical integration methods, such as the Runge-Kutta equations, are used to determine 
their solution. Truncating the modeshapes matrix, d> , reduces the number of differential 
equations to be integrated. Equations (3.13) show the conversion back to physical space: 
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and 


x = Ot| 
x = Of| 


(3.13a) 


x = d>fj 

= OA" 1 H2Cco]n-[o) 2 ln . (3.13b) 

+[0/ + 0/9*]^ { m) x m,r\} } + &VU 

This derivation is valid for the interaction of any two dynamic systems, if at least 
one is defined in mode space. There are two drawbacks to this method. The first is that 
the mass parameters of the manipulator must be known, but this is an issue that arises in 
any computer simulation. The second is that the nxn matrix of mass values, A, must be 
inverted at each time step. This can become computationally intensive and time- 
consuming if a large number of modes are included in the simulation. For slow motions of 
the manipulator its mass matrix [M,] does not appreciably change during a single 
simulation time step. In this situation, the matrix A can be computed and inverted only 
every N time steps, where N is the number of time steps over which the matrix is assumed 
constant. 
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4. System Performance 


This chapter presents experimental results. High frequency noise and low 
frequency drift are shown to be present on the measurements from the force sensor. The 
VES simulation, performing trajectory and admittance control motions, is compared to 
experimental hardware results from MIT. The computer simulations developed in 
chapters 2 and 3 are compared with the PUMA 560 mounted on the SRMS end effector. 
Results are also given for the DOSS, a proposed flight arm, mounted on the SRMS. 

4.1 Force-Torque Sensor Performance 

The force-torque sensor manufactured by Advanced Mechanical Technology, Inc., 
and described in section 2.2, is analyzed. Long and short duration experiments, that verify 
the presence of noise components on the measurements, are discussed. 

4.1.1 Short Term Experiments 

A number of short term experiments were performed on the force sensor to 
analyze the presence of high frequency noise on the output of the sensor. The sensor was 
unloaded, so it should have measured no wrench components. Figure 4.1 shows 
representative results for one second of data collected at 100 Hz. The forces in the X- 
and Y- directions have maximum amplitudes under 1.0 N, while the force in the Z- 
direction is slightly larger, with spikes up to 3.0 N. The moments are all under 1.0 Nm. 



Noise (Nm) 



(e) Y Moment (f) Z Moment 

Figure 4. 1 Noise Associated with the Forces and Moments Measured by the Force- 

Torque Sensor for a 1 Second Experiment Sampling at 100 Hz, (a) X Force, 
(b) Y Force, (c) Z Force, (d) X Moment, (e) Y Moment, (f) Z Moment 
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The force-torque sensor is composed of strain gages in Wheatstone bridge 
formations. These are all linear devices, and should not introduce any 
extraneous noise components. The source of the noise was traced back to the ground, 
which was not a clean signal. 

The presence of the noise on the force and moment measurements is capable of 
corrupting the results of experiments. The data will not be reliable if the reaction wrench 
that the force sensor is reading is on the order of the noise component. 

4.1.2 Long Term Experiments 

Longer duration experiments were performed to determine the effects of the 
environment on sensor readings. Figure 4.2 illustrates tests that were performed over a 
period of 65 hours, with data collected at 30 minute intervals. The data is observed to 
contain a low frequency component with a period of approximately 24 hours. Figure 4.3 
shows a time history of the temperature in the laboratory, for the duration of the 
experiment. There appears to be a correlation between temperature and sensor 
measurements. 

Advanced Mechanical Technology, Inc. states that the sensor has a 0.01%/°C 
sensitivity change with temperature over the region from -17 to + 52°C [“Model OR6-5-1 
Biometrics Platform Instruction Manual”, Advanced Mechanical Technology, Inc., 
Newton, Massachusetts, January 1987]. Therefore, the 2.5°C temperature fluctuation 
over the duration of the experiment does not account for the large oscillations in sensor 
measurements. It is possible the sensor is sensitive to other environmental factors, such as 
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(c) Z Force 


(d) X Moment 



Time (hours) Time (hours) 


(e) Y Moment (f) Z Moment 

Figure 4.2 Long-Term Drift Associated with the Forces and Moments Measured by the 
Force-Torque Sensor for a 65 Hour Experiment Sampling Every 30 Minutes, 
(a) X Force, (b) Y Force, (c) Z Force, (d) X Moment, (e) Y Moment, (f) Z 
Moment 
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Figure 4.3 Temperature Time History for Duration of 65 Hour Experiment 


electro-magnetic fields and computer activity in the laboratory. During the evening hours, 
when the temperature drops, the computer activity in the laboratory also declines. This 
could affect the power signal that powers the sensor. 

Most experiments will be performed on the order of minutes, as opposed to hours. 
These results show, however, that the sensor will need to be re-calibrated every 3 to 4 
hours to ensure reliable readings that are independent of long-term drift. The force in the 
Z-direction is most susceptible to environmental effects, so it will need to be monitored 
more closely than the other wrench readings. 

4.2 VES Computer Simulation Validation 

Section 2.3 illustrated that the VES is capable of admittance and trajectory control. 
Kuklinski has studied the MIT Stewart Platform dynamic motion capabilities [7]. His 
experiments involved both trajectory and admittance control on the platform. The NASA 
Langley VES is not currently operational, so the VES computer simulation described in 
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chapter 2 is compared to the results from MIT. In this section, all motions are about the 
platform frame, {P }, from fig 2.1. The rotations about the x-, y-, and z-axes are alpha, 
beta, and gamma, respectively. 

4.2.1 Trajectory Control 

The YES operates under PD control, with user-specified values for the position 
and derivative gains. The VES simulation was used to track a sinusoidal motion in the z- 
direction, with an amplitude of ±0.2m and frequency of 0.5 Hz. The position and 
derivative gains were 8500 and 0, respectively. Figure 4.4 shows the commanded z- 
translation, and the simulated z-translation, as computed by the forward kinematics code 
(refer to fig 2.2). The error between the commanded and simulated positions is presented 
in fig 4.5a. Figure 4.5b shows the position error associated with the MIT YES hardware 
performing the same maneuver with identical gains. All experiments were performed for a 
duration of three seconds, with a 100 Hz sampling rate. 

The results show that the platform motion lags behind the commanded translation, 
which is common in mechanical systems. Comparing figs 4.5a and 4.5b, it is observed that 
the simulation data are similar to the MIT experimental results. The larger position error 
associated with fig 4.5b could be due to friction or hysteresis in the hardware, which is not 
currently modeled in the computer simulation. After the NASA YES is operational, 
experimental test results can be compared to the simulation, which can be altered 
accordingly. The simulation was not changed to model the MIT results exactly because all 
physical systems are different, and the simulator is supposed to model the NASA VES. In 
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terror tin; 



Time (sec) 


Figure 4.4 Commanded and Simulated Z-Translation for Trajectory Control: ±0.2m 
Amplitude, 0.5 Hz Frequency 



(a) YES Computer Simulation (b) MIT YES Hardware 7 


Figure 4.5 Position Errors when Tracking Z-Translation of VES: (a) VES Computer 
Simulation (b) MIT VES Hardware 7 
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addition, the data from each leg actuator is required to modify the simulation and such 
data was not available from MIT. 

As a second test, the simulation was used to track sinusoidal motion about the x- 
axis, with an amplitude of ±20°, 0.5 Hz frequency, and the same PD gains. The 
commanded and simulated rotation, from the computer simulation of the Stewart 
platform, are illustrated in figure 4.6. Figures 4.7a and 4.7b show the rotational errors 
between the commanded and simulated rotation from the computer simulation, and errors 
from the same experiments performed at MIT. The simulation errors are slightly larger, 
but are close enough to verify that the simulator performs rotational control correctly. 



Figure 4.6 Commanded and Simulated Alpha-Rotation for Trajectory Control: ±20° 
Amplitude, 0.5 Hz Frequency 
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(a) YES Computer Simulation 



Figure 4.7 Position Errors when Tracking Alpha-Rotation of VES: (a) VES Computer 
Simulation (b) MIT VES Hardware 7 


42.2 Admittance Trajectories 

The VES Simulink simulation was used to emulate an admittance model, without 
the presence of an added mass on the force sensor. The simulated motion was that of an 
unforced damped harmonic oscillator. The mass, spring, and damping parameters are 
shown in Table 4.1. The generalized coordinates are: {x, y, z, a, (3 , y } T . 

Figure 4.8 shows the commanded positions and orientations, and the results from 
the VES simulation. The differences between the commanded and simulated platform 
positions are shown in fig 4.9a. The corresponding results from the MIT hardware are 
shown in fig 4.9b. The orientation errors are shown in figures 4.10a and 4. 10b. With the 
exception of the rotation about the y-axis (beta rotation), the simulation errors are up to 
two times larger than the hardware errors. The phase lags associated with the MIT results 
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Translation (m) 


Mass Parameters 

Spring Constants 

Damping Constants 

mi : 500 kg 

K„ : 1500 N/m 

C u :500N/m/s 

m 2 : 500 kg 

K 22 : 2500 N/m 

C 22 : 500 N/m/s 

m 3 : 500 kg 

K 33 : 4000 N/m 

C 33 : 500 N/m/s 

I 44 : 250 kg m 2 

K 44 : 1500 N m/rad 

C 44 : 250 N m/rad/s 

I 55 : 250 kg m 2 

K 55 : 1000 N m/rad 

C 55 : 250 N m/rad/s 

lee : 250 kg m 2 

: 2000 N m/rad 

C66 : 250 N m/rad/s 


Table 4. 1 Admittance Model Parameters 7 




(a) Platform Position (b) Platform Orientation 

Figure 4.8 Commanded and Simulated Platform Position and Orientation for Admittance 
Trajectories, Using a Decoupled Mass- Spring-Damper, (a) Position, (b) 
Orientation 
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(a) VES Computer Simulation 


(b) MIT VES Hardware 7 


Figure 4.9 Platform Position Errors from Admittance Control of VES: (a) VES Computer 
Simulation (b) MIT VES Hardware 7 




(a) VES Computer Simulation 


(B) MIT VES Hardware 7 


Figure 4.10 Platform Orientation Errors from Admittance Control of VES: (a) VES 
Computer Simulation (b) MIT VES Hardware 7 


are also larger. The sources of the inconsistencies between the software simulations and 
the hardware experiments cannot be determined without data from each actuator for the 
duration of the experiment, which was not available. The simulation results can be 
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improved once data is available from the NASA VES. These results show that the 
software simulation is capable of modeling the hardware for admittance control. 

4.3 Comparison of the Two Computer Models With the PUMA 560 and DOSS 
Mounted To the SRMS End Effector 

The previous section determined that the VES software simulation is able to model 
the VES hardware. This section presents a comparison of the VES simulation with the 
SRMS-robot computer model developed in chapter 3. 

Both computer simulations were executed with the PUMA 560 mounted on the 
SRMS end effector. The SRMS was modeled with a damping value, £ = 0.02. The first 
joint of the PUMA 560 was moved 30° in five seconds, while the remaining five joints 
were stationary. This motion involved moving the robot’s most massive joint in a short 
period of time, and was intended to create a considerable wrench on the SRMS end 
effector. 

The motions resulting from the simulations are shown in figures 4.1 1-4.18. 
Comparison of the figures shows that the VES simulation and the SRMS-robot simulation 
produced nearly identical results for all SRMS configurations. The increased damping 
associated with the Simulink results is due to the added filters (refer to fig 2.15). The close 
comparison between the models illustrates two points. First, it appears to be valid to 
assume in the SRMS-robot model that the wrench due to the robot could be split into two 
components, one due to the articulating robot on a stationary base, and another due to the 
compliant base under a stationary robot. This assumption appears to be valid. Second, 
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(a) Position 


(b) Orientation 


Figure 4.1 1 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Unberth 
Configuration, with PUMA 560, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.12 VES Simulation: Commanded Platform Motion for SRMS Unberth 
Configuration, with PUMA 560, (a) Position, (b) Orientation 
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(a) Position (b) Orientation 

Figure 4.13 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Low 
Hover Configuration, with PUMA 560, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.14 VES Simulation: Commanded Platform Motion for SRMS Low Hover 
Configuration, with PUMA 560, (a) Position, (b) Orientation 
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(a) Position 


(b) Orientation 


Figure 4.15 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Deploy 
Configuration, with PUMA 560, (a) Position, (b) Orientation 
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(b) Orientation 


Figure 4.16 VES Simulation: Commanded Platform Motion for SRMS Deploy 
Configuration, with PUMA 560, (a) Position, (b) Orientation 


59 






rosition icm; 




(a) Position (b) Orientation 

Figure 4. 17 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Capture 
Configuration, with PUMA 560, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.18 VES Simulation: Commanded Platform Motion for SRMS Capture 
Configuration, with PUMA 560, (a) Position, (b) Orientation 
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the SRMS-robot model can be used as a comparison to the actual VES motion, and can 
predict anticipated motions before they are implemented in the hardware. 

Both computer simulations were executed with the shoulder pitch of the DOSS 
moving 30° in five seconds. Figures 4.19-4.26 compare the SRMS end effector motions 
for the two simulations. The DOSS is a proposed flight arm, and these results show that 
the anticipated motion of the SRMS end effector is on the order of centimeters for this 
maneuver. Different DOSS motions could produce larger SRMS disturbances, as could a 
payload attached to the DOSS. 
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position \C1U; 



(a) Position 



Figure 4. 19 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Unberth 
Configuration, with DOSS, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.20 VES Simulation: Commanded Platform Motion for SRMS Unberth 
Configuration, with DOSS, (a) Position, (b) Orientation 
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(a) Position (b) Orientation 

Figure 4.21 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Low 
Hover Configuration, with DOSS, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.22 VES Simulation: Commanded Platform Motion for SRMS Low Hover 
Configuration, with DOSS, (a) Position, (b) Orientation 
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(a) Position 


(b) Orientation 


Figure 4.23 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Deploy 
Configuration, with DOSS, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.24 VES Simulation: Commanded Platform Motion for SRMS Deploy 
Configuration, with DOSS, (a) Position, (b) Orientation 
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(a) Position (b) Orientation 

Figure 4.25 SRMS-Robot Simulation: SRMS End Effector Motion for SRMS Capture 
Configuration, with DOSS, (a) Position, (b) Orientation 




(a) Position (b) Orientation 

Figure 4.26 VES Simulation: Commanded Platform Motion for SRMS Capture 
Configuration, with DOSS, (a) Position, (b) Orientation 


65 






5. Conclusions 


The Vehicle Emulation System is used to simulate the interaction of an active 
robotic arm and a mobile base. The force-torque sensor is the interface between the two 
dynamical systems. The operation of the VES hardware and software was described. A 
computer model of each component, and their interaction, was presented. The computer 
simulation was developed using the Simulink software package from the Mathworks. The 
simulation included models of the robot, force-torque sensor, VES control software, 
actuator dynamics and control, and VES forward kinematics. 

A computer simulation of the dynamic interaction of an active robotic arm on a 
mobile base was presented. The mass matrix of the robot was coupled to the mass matrix 
of the mobile base, defined in mode space. The input to the modified admittance model is 
the wrench due only to the robot’s motion. 

This VES simulation output was compared with experimental results from the MIT 
VES, and shown to be an accurate representation of the hardware for both trajectory and 
admittance control. The model was also compared with the computer simulation of the 
robot-mobile base interaction. This comparison verified the accuracy with which the VES 
simulation modeled the dynamics. It also showed that splitting the wrench into two 
components, one due to the articulating robot on a stationary base, and another due to the 
compliant base under a stationary robot, in the robot-mobile base simulation, was a valid 
assumption. 

Simulations were executed such that the most massive joint of each robot was 
commanded to move a large distance in a short amount of time. Results from the two 
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simulations indicate that the SRMS end effector is expected to be displaced by no more 
than two centimeters for the worst case motion. However, different robots or the same 
robots with large payloads could cause the SRMS to experience increased disturbances. 
Future studies can involve investigating the effects different robots have on the SRMS- 
robot computer simulation developed in chapter 3, to determine the reaction of the SRMS 


end effector. 
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Appendices 


A. Newton-Euler Equations 

This Appendix presents the iterative Newton-Euler dynamics algorithm, as 
outlined by Craig [16]. In this thesis, the equations are used to determine the forces and 
moments generated at the base of a serial robot, given the joint angles, rates, and 
accelerations of the robot. The approach is based on the work done previously by Luh, 
Walker, and Paul on the topic of computational schemes for manipulators [17]. The 
following equations are from [16] and illustrate the outward iteration of velocities and 
accelerations, and the inward iteration of joint forces and moments. 

Outward iterations: i : 0 — >[n-l] 


i+\ r 


+e i+1 ‘ +1 2 i+1 . 


«+!<■ 


<+l 


CO, 


-^cd^g); +e, +1 ' +I z i+1 , 


i+! 


' +1 V, + l=‘^('C0 1 X‘/> +1 +‘C0 I X ('to,.x^ +1 )+‘v,), 

i+ 1 v Ci+ 1 - + 1 co 1 + 1 x i+ 1 P c . +l + i+, co ,. +1 x ( ,+ 1 co i+ 1 x' + 1 P C;+ 1 )+' + 1 v i+1 , 


,+l F = m i+l v 
r i + 1 rr k+\ v a+ 1> 

i+1 A/ = c i+i I 4- i+1 m y c -*> I i+1 rrt 

yv ;+i 1 i + 1 cu i+1 -r dj (+1 x i i+1 cu i+1 . 


Inward iterations: i : [n] — > 1 

.&% 


where 




'co, is the angular velocity of link i in its own frame, 


[Cl] 
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‘v- is the linear velocity of link i in its own frame, 

‘v c . is the linear velocity at the center of mass of link i, 
m l is the mass of link i, 

c, 7 ; is the inertia of the i 4 * 1 link at its center of mass, in its own coordinate frame, 
0, and 0. are the joint rate and acceleration of the i th joint, 

‘Z; is the unit vector in the z-direction for link i, 

‘P i+l is the position vector from link i to link (i+1), 

‘P c . is the position vector from link i to its center of mass, 
i+ [R is the rotation matrix from link (i+1) to link i, 

'F l and ‘N t are the forces and moments at the center of mass of link i, and 
'/; and are the forces and moments at link i. 
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B. Gravity Compensation 


Earth-based experimentalists who study space-based systems must take into 
account the effects of gravity. Submersing the hardware in a neutral buoyancy tank is one 
possible solution, but this method complicates the dynamics. Air bearing tables are 
another solution, but they are capable of only two-dimensional motions. The VES is able 
to perform three-dimensional motions, without complicating the dynamics. 

Kuklinski presents an iterative technique for determining the effects of gravity, 
using the VES [7]. First, the manipulator is moved sufficiently slowly that dynamic effects 
are negligible, along a pre-planned trajectory, with the platform held stationary. At each 
time step in the control software, the wrench is read from the force sensor. Then the 
platform is run under admittance control, as the robot is commanded to follow the same 
path. The platform position data at each time step is combined with the position output of 
the admittance model, in a weighted average. These position values are used to command 
the platform during the next iteration. This process is repeated until the platform position 
converges to the desired degree of accuracy. This method is limiting because the robot is 
not allowed to follow a general trajectory to perform a task, as commanded by a hand 
controller or vision control system. In addition, every experiment must be executed 
numerous times in order to cancel the gravity effects. 

The NASA-Langley VES will employ a different method that can be performed 
on-line, without iteration. This method depends on the mass parameters of the robot, 
along with its joint angles at each time step. 
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Each link of a manipulator has associated with it a mass and a vector defining the 
location of the center of mass, with regard to a chosen coordinate system. Therefore, an 
n-DOF robot has 4(n+l) mass parameters, including the fixed base link (link 0). West, et 
al [8] have developed a method for estimating combinations of the mass parameters of a 
manipulator that is mounted on a movable force-torque sensor. A modified version is 
presented here. 

A homogeneous transform matrix is used to map one coordinate frame into 
another [16]. Referring to fig B.l, the location of point Q can be described with reference 
to frame {A} as 

■V V=V/w+X(%). (B.i) 



Figure B.l Vector Diagram to a Point in Space 
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where l (jP k ) is the vector from j to k , expressed in / coordinates. k R is the 3x3 
rotation matrix from frame k to j . A 4x4 transform matrix is used to express the right 


hand side of eq (B.l) as a single term with the following structure 


Vp q )1_ 


bR 

Lfooo} 


A iX) 


B ( B Pq ) 1 


(B.2) 


or 


A ( A Pq)=bT B ( B Pq )■ 


(B.3) 


When a stationary object of mass m is placed on an arbitrarily oriented six-DOF 
force-torque sensor, the following measurements are taken 


F x = mg x 
P y = mg y 
F z = mg z 

M x = r y F z -r z F y (] 

M y = r z F x ~ r x F z 
M = r F — v F 

1,1 z 'x 1 y 'y l x 

where the gravity vector has been rotated according to the following X-Y-Z fixed-axis 
rotation 



cosy cosp 
sin y cos P 
-sin p 


cosy sin P sin a - sin y cos a 
siny sin p sin a - cosy cosa 
cos P sin a 


cosy sin p cosa + siny sin a 
siny sin p cosa - cosy sin a 
cos P cosa 


(B.5) 


The angles a, P, and y are rotations about the inertial X, Y, and Z axes, respectively [18], 
The center of mass is located at {r x ,r y ,r z } with reference to the force sensor. Note that 
the moment equations are linearly dependent, since 

n M i + r j M j = ~rkM k , (B.6) 
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for I,/, and k not equal. For an n-DOF robot, the moment equations at the base due to 

link i are simplified to the following form using homogeneous transform matrices 

M x ) f/?(3,3)7(2,l)-/?(2,3)7(3,l)j f/?(3,3)7(2,2) - i?(2,3)7(3,2) 

' M y ’ =(m l x i g> «(1,3)7(3,1)-/?(3,3)7(1,1) ■ + (m i y i g)- /?(1,3)7(3,2) - tf(3,3)7(l,2) ► 
M J . *(2, 3)7(1, 1) - /?(1, 3)7(2, 1) R( 2, 3)7(1, 2) - fl(l,3)7(2,2) . 

fl(3,3)7(2,3) - /?(2,3)7(3,3)| f/?(3,3)7(2,4) - /?(2,3)7(3,4)| 

+(^z,.gy /? (1,3) 7 (3,3) - (3,3)7 (1,3) ’ + (^g) /?(1,3)7(3,4)-/?(3,3)7(1,4) ' 

. T?(2,3)7(l,3) - fl(l,3)7(2,3) (2,3) 7 (1,4) - /?(1,3)7(2,4) . 

i = (B.7) 

The total wrench at the base of the robot is the sum of the wrench components due to 
each link. Equation (B.7) illustrates that for each orientation of the robot and base, the 
unknown mass parameters can be separated from the known transform matrix values. 

Since only two of the moments are linearly independent, by placing the robot and base in 
4 (n+ 1)/2 different orientations, all of the parameters can be determined by inverting the 
following equation 


(B.8) 
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In equation (B.8), M x and M y have arbitrarily been chosen as the moments to be 

measured. The elements of the [4(n+l)]x[4(n+l)] matrix are evaluated from eqs (B.7). 

The drawback to this method is that, for certain links of the robot, some of the 
elements in eqs (B.7) are linearly dependent. For example, the center of mass of link (i+1) 
cannot be translated parallel to its axis of rotation, with regard to the link i coordinate 
frame. It is not possible to distinguish between this product of mass and distance, and the 
link i quantity that also lies in this direction. Only their sum can be determined, resulting 
in k quantities that can be estimated (k<4(n+l)). This results in a reduced, kxk, form of 
equation (B.8), which is different for every robot. 

The static model of a robot determines the forces and moments it creates due to 
the effects of gravity. This is also called the gravity compensation model. The dynamic 
model of a robot takes into account the motion of the robot. The previous section 
describes a method for estimating combinations of the mass parameters of a manipulator, 
through inversion of eq (B.8). If the parameters are assumed known, then equation (B.7) 
is evaluated to determine the moments at the base of the robot, due to each link. The 
forces at the base are evaluated from the top three equations from eqs (B.4). These are 
the equations the NASA YES will use to the cancel the effects of gravity. 
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C. Description of YES Control Software Subroutines 


The Vehicle Emulation System employs control software to command the motion 
of the Stewart platform. The control software is comprised of seven main subroutines. 
They are: 

• Force Measurement 

• Gravity Compensation 

• Admittance Model 

• Trajectory Generation 

• Inverse Kinematics 

• Safety Checks 

• Leg Communication 

The following paragraphs briefly describe the algorithm associated with each subroutine. 

• Force Measurement 

The force-torque sensor measures the applied wrench due to an external forcing 
function. The analog signal is amplified, converted to digital units, and then made 
available to be read by the software. 

The force measurement routine begins by sampling the first six channels of the A/D 
converter. (The seventh A/D channel is for pressure measurement, which is used in the 
safety checks software). Each channel contains a bias which is determined by running the 
calibration routine beforehand. These values are subtracted from the readings, resulting in 
a digital representation of the actual applied wrench. 



Equation (4.6) illustrates the transformation the wrench undergoes as it is 
measured by the force sensor, amplified, and digitized by the A/D converter. In the 
software, the digital representation of the wrench is multiplied by the inverse of 

[C pr J, to retrieve the analog wrench: 

{W} =[«-*{!/«} =[Cproc]{V R ), (C.l) 

The crosstalk and sensitivity matrices provided by AMTI are in the SI units of measure, so 
the resulting wrench components are in Newtons and Newton-meters. The wrench is now 
expressed in the force sensor coordinate system, which is different from the platform 
frame by a 180° rotation about the x-axis of the platform, and a translation in all 
coordinates to the force sensor top plate. The code performs this transform and then 
rotates the wrench to the inertial frame. 

• Gravity Compensation 

The force-torque sensor reads the static, along with the dynamic, wrench created 
by the manipulator. The gravity compensation routine determines the static effects and 
subtracts them from the applied wrench. 

West, et al [8] derive a procedure to estimate the mass parameters of a 
manipulator. This is accomplished this through a measurement of the static wrench the 
robot creates at its base. If these parameters are known, then this method can be inverted 
to compute the static wrench, assuming the manipulator’s joint angles are known. The 
forces and moments are calculated using the relations F = mg and N = rXF, respectively, 
for each link. The NASA VES will employ this method of gravity compensation. Refer to 
Appendix B for a further discussion regarding the equations. 
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The robot is assumed to be a rigid body. First, the gravity vector is rotated from 
the inertial frame to the base frame, and then the force exerted by each link of the 
manipulator is computed. The forces are summed to represent the complete force. The 
moments are computed using the method presented in Appendix B. Next, the wrench is 
translated through the robot adapter plate to the force sensor frame, and then rotated and 
translated through the force sensor to the platform coordinate system. Finally, the wrench 
is rotated to the inertial frame, through the roll-pitch-yaw transformation, eq (C.l). The 
force measurement routine reads the entire wrench exerted on the force sensor, which 
includes the robot static and dynamic wrench, the mass of the force sensor top plate, and 
the robot adapter plate. The computed static effects due to the robot are added to the 
masses of the plates, and this sum is subtracted from the measured wrench. The dynamic 
wrench due to the robot remains, to be used in the admittance model. 

• Admittance Model 

An admittance model determines future states of a dynamic system, given the 
present input wrench and state. For a general second order system, an admittance model 
has the form 

[Mim + icm + mix} = mm, cc.2) 

where [M], [C] and [A - ] are the systems’ mass, spring, and damping matrices, {W} is the 
input wrench, and [£] is the input matrix. Chapter 3 presents a method for transforming 
an admittance model from physical to mode space. The relationship between physical and 
mode space is 

W = [<£]{T1}, (C.3) 
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where {r|} are the modal coordinates. Substituting eq (C.3) into (C.2) and using mass 


normalized modeshape matrices yields 


um+ 


\ 


[■••• 1 

2£co, 

{T|} + 

1 

_e 

to 

L 




i 1>2 


(C.4) 


where co ( are the natural frequencies of the modeled system, C, is the damping coefficient, 
and [j 3] is the identity matrix. Equation (C.4) is represented in state space as a series of 
2n first order systems of the form 


Til =^2 

f| 2 = — cofo - XfiOfo + ([0] T {W})| row(i) 


(C.5) 


where T| 1 and r\ 2 are the modal state and its time derivative, respectively. The admittance 
model is evaluated using a discrete form of the state space equations, so equations (C.5) 
are discretized to 


{W = [<M0U + [n{w}. (C.6) 

Appendix D contains a derivation of the [<(>] and [F] matrices for the decoupled equations 
given above. The conversion back to physical space is 

\x}=mm), 

{i} = [0]{TiJ, (C.7) 

m = pDHfj} = [<D][-2£toJ{f|} + [O][-C0 w 2 ]{ti} + [<D][O r ]{W }. 

• Trajectory Generation 

While the admittance model software computes the motion of a dynamic system, 
the trajectory generation code commands the YES to follow a pre-planned path. The 
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system is capable of ramping (linear) and sinusoidal motion. The platform can be 
instructed to move in one Cartesian direction, or a combination of all directions. 

For ramping motion, the user interface allows the user to enter the desired final 
Cartesian coordinates of the center of the platform top plate, and the trajectory time, t fmal . 

The initial coordinates are known. The number of time steps, N, required for the motion 
is determined from 

N = 10 0t final , 


where the code operates in real time at 100 Hz. Equations (C.8) are used to determine the 
amount by which to increment each coordinate at each time step. Equation (C.9) 
computes the new coordinates. 


A ( - = 


(I final ^initial ) 


N 


i = x,y,z,Q x ,Q y ,Q z 


hew ~ iold 


(C.8) 

(C.9) 


If sinusoidal motion is desired, the user is prompted to enter the amplitude, \ , and 
frequency, / ; , of the motion, for each coordinate. Equation (C.10) is used to compute the 
motion at each time step, t. 

i new = hnitiai + A sin(27t/;0, i = x, y,z,Q x ,Q y ,Q 2 (C. 10) 

When the trajectory generation software routine is used, either equation (C.9) or 
(C.10) is used at each time step. 

• Inverse Kinematics 

For a general robotic manipulator, the inverse kinematics solution is used to 
determine the joint angles or actuator lengths, given the position and orientation of the end 
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effector, with respect to some coordinate system. The six ball joint locations at the base 
of the platform are known from the geometry of the VES, and the Euclidean norm is used 
to calculate the leg lengths: 

L, =[pT]{ p ( B P Pi )}-{ B ( B P B .)) i = 1,2, ...6, (C.ll) 

W = ||% (C.12) 

In equation (C.ll), p { B Ppi } is the Cartesian position of the i* platform ball joint with 
respect to the base, in platform coordinates, and b { b Pbi} is the location of the i* base ball 

D 

joint with respect to the base, in base coordinates. [ P T] is the transformation from the 
platform to the base frame. 

The inverse kinematics software routine is as follows. First, the rotation matrix 
from the platform frame to the inertial frame is calculated. Then the platform joint 
locations are transformed to the base frame, and the actuator vector lengths are computed 
using equation (C. 11). Finally, the leg lengths are calculated using eq (C.12). 

• Safety Checks 

Various safety requirements are checked at each time step, to ensure that the new 
leg lengths are within the workspace of the system, and that control over the platform has 
not been lost. Ref. [7] contains a detailed description of each safety software routine. 

They are briefly outlined below. 

Velocity Check: Checks the difference between successive commanded leg 
lengths, to determine if they are within required limits. 
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Position Error Check: Computes the difference between the commanded length of 
each leg and the measured value, to determine if they are within required limits. 

Collide: Determines if the new platform geometry will result in a collision between 
adjoining legs. 

Motion Limits: Checks each commanded Cartesian coordinate to determine if it is 
within the workspace of the platform (±0.305 meters in translation, ±30° in rotation). 

Actuator Limits: Determines if each leg length is within required limits. 

Joint Limits: Checks to make sure that each joint angle has not been exceeded. 

Flow Limits: Checks the flow of each actuator by calculating the difference 
between successive lengths of each leg, to determine if it is within required limits. 

Panic Button and Floor Mat: A person standing on the floor mat surrounding the 
Stewart platform, or pressing the panic button, generates an interrupt to the control 
software, and the motion is stopped. 

• Leg Communication 

After the inverse kinematics are invoked to determine the new leg lengths, and the 
safety checks are performed, the leg communication routine computes the following leg 
command to send to each actuator: 

Id - LegOffset: 

LegCommandi = J — — — - — , i = 1,2, . . . ,6 , (C. 1 3) 

LegScalei 

where LegOffsetj and LegScale , are constants determined by the geometry of the 
platform. The software then exchanges information with the legHost chip that commands 
the legs. The code outputs the commanded leg lengths, and reads back the measured 
lengths. 


83 



D. Discrete State Space - Closed Form Solution for a 2-DOF System 

The Vehicle Emulation System uses discrete state space methods to integrate the 
admittance model of the base motion. This model is in modal space, and for a system 
utilizing n modes, the equations are decoupled into n second-order equations, or 2n first- 
order equations of the form 

^1=^2 

f| 2 = ~(o\ - 2£co i r) 2 + m T {W})\ row(i) ’ (D-1) 

where r\ are the modal coordinates, to, is the natural frequency of the i 111 mode, C, is the 
modal damping, is the modeshapes matrix, and {VK} is the externally applied wrench. 

In state-space, the equations have the form 

{Ti} = [A]{Ti} + [fi]{«}, (D.2) 


where 


[A] = 


0 1 
L-co 2 -2£cq 


(D.3) 


The admittance model is evaluated using a ZOH, so equations (D.2) are discretized to 


r\(T)=e A, y](T-l)+ \e AKl ~ x, Bu{x)dx 

T - 1 


A(T- T) j 


= e AT X](T-l) + 


}e MT ^dl 


L7--1 

= e AT V[{T - 1) - A~\I - e Ax )Bu 


\Bu 


(D.4) 


or 


oi„ + i )=w {TU+[n{M}. 


(D.5) 
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Equations (D.4) present a discrete approximation to the admittance model. It is 


based on the previous state, and current input. The e AT expression is evaluated using 
Laplace transforms, as follows: 


where 


e AT =$ = t l (si- A )[ =t = 


s -1 

Leo 2 £ + 2^00 J 


1 

< 

,s + 2£co 1 ] 

5 2 + 2^C0j' + C0 2 

-CO 2 5.J 


^1 -** $2 $3 

L <l>4 <M 


*1 = t- l \ 
<l>2 = ^ 

fe = H 


/ + 2£cos + co 2 j 

2Cco 

,^ 2 +2^0)5 + 0) 2 . 
1 

s 2 + 2C,o)s + co 2 , 

J -to 2 

^4 - ^ 1 „2 , 


k s 2 + 2£co.s + co 2 J sJl-C, 


= e sin( 0 )T -x/l — C 2 - cos -1 (Q) 

= j^e^ T sin((0TjrC) 

= e** sin^VR 7 ) 

w-c 

e" 5 “ r sin(cor7l-C 2 ) 


(D.6) 


(D.7) 


and 


[A]-' = 



-1/co 

0 


(D.8) 
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E. Admittance Control Stability Issues 


This Appendix describes the concept of admittance control as it is implemented by 
the VES. It is shown that using a ZOH on the force- torque sensor’s measurements could 
impose restrictions on the VES software admittance model. 

Admittance control involves determining the current state of a dynamic system 
given its previous state and input forces and moments. If the admittance model is defined 
in Cartesian space, then the state is composed of the position and orientation. For systems 
with many degrees-of-ffeedom, the admittance model may be a truncated form of the 
equations of motion, defined at a particular point within the system. The VES operates 
with an admittance model. The VES allows the interaction of two dynamical systems: an 
active robotic arm, and the Stewart platform, which is emulating the motion of a general 
flexible mobile base. The force-torque sensor is the interface between the two systems. 

As this Appendix will illustrate, discretizing the measurements from the sensor may 
introduce limitations on the admittance model concept. For a robot directly attached to 
the actual mobile base being emulated, the motions of one mechanism directly affect the 
other mechanism, and the system is generally stable. Therefore, the limitations are a result 
of the experimental hardware. 

Figure E.l shows a one degree-of- freedom (DOF) mass- spring-damper system. 

The equation of motion is 

mx(t) + cx(t) + kx(t) = 0, (E.l) 

which yields a stable system for mass, damper and spring values greater than zero. 
Addition of a second mass, rt \ , rigidly attached to mass m, changes the equation to 



(m+m l )x(t) + cx(t) + kx(t) = 0. (E.2) 

This situation is depicted in fig E.2, and is also stable under the same conditions. Bringing 
the added mass to the right hand side of equation (E.2) yields 

rrixit ) + cx(t ) + kx(t) = -mfiit) = W , (E.3) 

where W is the wrench, and is a single force for the 1-DOF case. Finally, introduce a 
fictitious one degree-of-freedom force sensor/transmitter between the two masses (refer to 
figure E.3). This sensor/transmitter is massless and dimensionless, so that its presence 
does not physically alter the model. The sensor/transmitter is designed to measure the 
analog force, -n\x(t), that the added mass exerts on the original system, and then transmit 
this force through to the mass- spring-damper, which then reacts accordingly. 

The situation described is the manner in which the VES operates. The reaction 
wrench, W , due to an articulating external mass on a flexible base is measured by the 
force-torque sensor. This wrench is digitized, though an analog-to-digital converter, and 
transmitted to the control software. Calculations are performed in the software to move 
the Stewart platform, using the desired admittance model of the flexible base. 

Returning to the one dimensional illustration, it is observed that the presence of the 
force sensor/transmitter has changed the situation. If the sensor/transmitter is sampled at 
intervals, T , then equation (E.3) is no longer valid. Discretizing the output of the 
sensor/transmitter introduces a zero-order-hold on the wrench before it is transmitted to 
the mass- spring-damper. The equation of motion, over the interval t n < t < t n+i , is thus 

mx(t) + cx(t) + kx(t ) = -n\x{t n ) = F{t n ) = constant , (E.4) 

where t n is the last time at which the sensor/transmitter updated an output force value, 



Figure E.l Mass-Spring-Damper System 



Figure E.3 Mass-Spring-Damper System with an Added 
Mass and a Force Sensor-Transmitter 
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« 


the sensor’s sampling period is x = t n+l - t n , and the feedback force is held constant over 
the time interval. The initial conditions are: x (t* ) = x(t~), and x (t* ) = x (t~). Dividing 
by m in eq E.3 yields 

x(t) + 2£coiO) + co 2 x(t) = rx(t n ) = F(t n ) = constant , (E.5a) 


or in state space 


Ml r o i im ( o | 

ly 2 J L-or -2£coJlyJ \rx{t n )\ 


(E.5b) 


where 2^co = c/m, co 2 = k/m , r = and [y l ,y 2 } T = {x,x} T . 

At the beginning of the interval, t = t n , the system has an initial position, x(t n ), 
velocity, x(t n ) , and a forcing function that is proportional to the acceleration, x(t n ) so the 
closed-form solution for x{t) over this interval is 


x(t) = x(t n )e^ a °f cos(co d (f - tj) +—sin(w d (t - t n )) 


co. 


x(0 




CO,, 


sin(co d (t-t n )) 


(E.6) 


rx{t n ) 


(0 


1 _ £-&»(<-<,) 


f tjco ^ 

cos(co d (t-t n )) + — sin(co d (t - tj) 


CO, 


J) 


where 0 ) d = co-y/l-^ 2 is the damped natural frequency. Time differentiation of eq (E.6) 
produces the velocity and acceleration over the time interval. 


co 


x(t) = --~x(t n )e~ w ‘ ° sin(o) rf (t - tj) 


co. 


e-^i(O d cos(co d (t -t n ))~ £co sin(co d (t - t n )j) (E.7) 


w '^sinlco/r-rj) 


CO, 


and 
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x(t) = -^sin(( 0 d (t - t n )) - cos(o ) d (f - t n )) 

+^^“ ( '-'“)( ( o 2 (2 C 2 - 1) sin(o) d (? - O) - 2£coco d cos(co d (r - *„))) . (E.8) 

+rx{t n )e < ^ , ~ , " ) I cos(co d (f - O) ~ 7 ”sin(co d (r - fj) 

v w d y 


Equations (E.6)-(E.8) apply over the entire sampling period. Note that they are all 
functions of the position, velocity, and acceleration at the beginning of the time step. 



or 

{y(n+l)}=[<|>]{y(rt)}, 

where 

Cco . 

a = coso^x + — sin ovx , 
co d 

P = 0) d COSCD d T - £co sin co d x , 
and 

y = G) 2 (2£ 2 - 1) sino) d x - 2£coto d cosco d x . 

Equation (E.9) is the discrete form of eq (E.5b), where the forcing function has been 
eliminated as a separate term, by including it in the state of the system. Equations (E.9) 
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are an exact representation of the continuous equations (eqs (E.6)-(E.8)) when they are 
evaluated at multiples of the sampling period. 

When operating in discrete state space, the conditions on stability are that the roots 
of the characteristic equation of the system are all less than or equal to one. The roots are 
determined from 


det[A/ -(()] = 0 . 

The characteristic equation for eq (E.9) is 


(E.10) 


)i+e ?<OT (- — £sinco d x-(2 + r)cosco d x)X z 


,rco 


(O 


rco£ . 


(E.l 1) 


+{e 2 ^ m (r + l) + e ?<OT (- — -sinco d x + rcosco d x)}X-/r ^ =0 


CO 


The exponential is also written as 

e -<m _ 

where F =(x)/2k, and / = 1/x is the sampling frequency of the force sensor. If the added 
mass, n\, is removed from the system, then r = 0, and the characteristic equation with no 
damping reduces to 


XQ l 2 - 2X coscox + 1) = 0 . 

The roots of this equation are all less than or equal to one for all values of (OX : 

X { = 0 

3 = coscox ± i sin cox ’ 


where i = 4-1. 


(E.l 2) 
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On the other hand, neglect damping in eq (E.l 1), and let the sampling period of the 
sensor reduce to zero, with r * 0 (including n\ again). Under these conditions, the % 

characteristic equation is 

(X-l) 2 (^-r) = 0. (E.l 3) 

The two repeated roots are oscillatory in nature. The third root is stable if 

M = IH=-N<1. (E.l 4) 

m 

This equation states that, in the limit as the sampling period of the sensor goes to zero, the 
largest allowable mass ratio is one. This is due to feeding back the acceleration into the 
admittance model. It is important to note that when the mass ratio is greater than one, the 
divergence of the system is dependent only on the number of time steps, and is 
independent of T . 

In general, the three roots of the characteristic equation are functions of the mass 
ratio, nty/m, the frequency ratio, f/F, and the damping. Two of the roots are repeated, 
and are stable. Figure E.4a shows a plot of the repeated root as the mass and frequency 
ratios are varied, with a damping coefficient, C, =0.5. This figure illustrates that as the 
sampling frequency of the sensor increases, the magnitude of the roots approach one. 

Figure E.4b shows a plot of the third root as the mass ratio and the ratio of frequencies axe 
varied, with the same damping. In general, control systems should be sampled at least 15 
times the largest frequency associated with the system, i.e., f/F > 15. The frequency 
ratio in the figures ranges from 10 to 100 in steps of 10, and as it increases, the magnitude 

v 

of the third root exceeds one for decreasing mass ratios. The instability is a result of the 
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(a) Repeated Root (b) Third Root 

Figure E.4 Magnitude of the Roots of the Characteristic Equation for Increasing Mass 
Ratio and Frequency Ratio, with £ =0.5, (a) Repeated Root, (b) Third Root 


ZOH on the feedback wrench. It is known that stability problems can arise in second 
order sampled systems [18]. 

This analysis can be generalized to a linearized N degree-of-freedom system, by 
writing eq (E.4) in matrix form: 

[M]{X(0} + [C]{X(0} + m{X(0}=-[M 1 ]{X(O}, (E.15) 

where 

[C] is the NxN damping matrix, 

[jST] is the NxN stiffness matrix, and 
[ M ] is the NxN mass matrix. 

Equation (E.15) is transformed to mode space by making the substitution 

{Z(0} = [O]{n(r)}, (E.16) 

where {r|} is the kxl vector of the modal coordinates, and [O] is the 6xk modeshapes 
matrix. The attraction to working in mode space is that the mass, spring, and damping 
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matrices become decoupled. Substituting eq (E.16) into eq (E.15), and pre-multiplying by 
[0] T produces 

<D t M®^(t)+® T C®f\(t)+Q> T K$n\(t) = -O ?M$ri\(t n ). (E.17) 


The matrix notation has been removed to avoid cluttering the equation. If mass- 
normalized modeshape matrices are used, then eq (E.17) becomes 


q(0 = -O t MjOfi(t n ) = R Ti(0 (E.18) 





■*. 

/II (0 + 

2^0), 

n(0+ 

CO, 2 


for i=l,2,...,k. This is the matrix form of eq (E.5a). Transforming (E.18) to discrete space 
yields a matrix similar to eq (E.9). Taking the limit of this matrix as the sampling period 
approaches zero, yields 


<j> = 


[/] 

[ 0 ] 


[ 0 ] [ 0 ] 
[/] [ 0 ] . 


(E.19) 


L[-0) 2 ] [-2Cco] [R] J 

With no damping, 2N roots of the characteristic equation are one, and N roots are the 
eigenvalues of [/?] . If any of the eigenvalues of [/?] are greater than one, unstable VES 
motion is produced. Pre-multiplying eq (E.15) by [M] -1 shows that [/?] can also be 
expressed in physical space as 


[R] = [MT l [M l l (E.20) 

where the stability condition is 

| eig(M -'M,)|<1. 
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